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Abstract — This paper provides new results for a tracking 
control of the attitude dynamics of a rigid body. Both of the 
attitude dynamics and the proposed control system are globally 
expressed on the special orthogonal group, to avoid complexities 
and ambiguities associated with other attitude representations 
such as Euler angles or quaternions. By selecting an attitude 
error function carefully, we show that the proposed control 
system guarantees a desirable tracking performance uniformly 
for nontrivial rotational maneuvers involving a large initial 
attitude error. In a special case where the desired attitude 
command is fixed, we also show that the attitude dynamics 
can be stabilized without the knowledge of an inertia matrix. 
These are illustrated by numerical examples. 

I. Introduction 

The attitude dynamics of a rigid body appears in various 
engineering applications, such as aerial and underwater vehi- 
cles, robotics, and spacecraft, and the attitude control prob- 
lem has been extensively studied under various assumptions 
(see, for example, [1], [2], [3], [4]). 

One of the distinct features of the attitude dynamics is 
that its configuration manifold is not linear: it evolves on a 
nonlinear manifold, referred as the special orthogonal group, 
SO (3). This yields important and unique properties that 
cannot be observed from dynamic systems evolving on a 
linear space. For example, it has been shown that there exists 
no continuous feedback control system that asymptotically 
stabilizes an attitude globally on SO(3) [5]. 

However, most of the prior work on the attitude con- 
trol is based on minimal representations of an attitude, or 
quaternions. It is well known that any minimal attitude 
representations are defined only locally, and they exhibit 
kinematic singularities for large angle rotational maneuvers. 
Quaternions do not have singularities, but they have ambigu- 
ities in representing an attitude, as the three-sphere S 3 double 
covers SO(3). As a result, in a quaternion-based attitude 
control system, convergence to a single attitude implies con- 
vergence to either of the two disconnected, antipodal points 
on S 3 [6]. Therefore, a quaternion-based control system 
becomes discontinuous when applied to an actual attitude 
dynamics, and it may also exhibit unwinding behavior, where 
the controller unnecessarily rotates a rigid body through large 
angles [7]. 

Geometric control is concerned with the development of 
control systems for dynamic systems evolving on nonlinear 
manifolds that cannot be globally identified with Euclidean 
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spaces [8], [9], [10]. By characterizing geometric properties 
of nonlinear manifolds intrinsically, geometric control tech- 
niques completely avoids singularities and ambiguities that 
are associated with local coordinates or improper characteri- 
zations of a configuration manifold. This approach has been 
applied to fully actuated rigid body dynamics on Lie groups 
to achieve almost global asymptotic stability [10], [11], [12], 
[13], [14]. 

In this paper, we develop a geometric controller on SO (3) 
to track an attitude and angular velocity command. The 
geometric attitude controllers studied in [10], [13], [14] are 
not desirable in the sense that the magnitude of their control 
input converges to zero when the initial attitude error is 
maximized, i.e. the Eigen-axis rotation angle between the 
initial attitude and the initial command approaches 180°. 
This reduces the initial convergence rate significantly, and 
it destroys the unique advantage of geometric control ap- 
proaches, namely effectiveness for large angle rotational 
maneuvers. 

The geometric tracking controller developed in this paper 
avoids this drawback by proposing a new configuration 
error function on SO (3), and it exhibits a good tracking 
performance uniformly in large initial attitude errors. We also 
show that when the attitude tracking command is fixed, i.e. 
a stabilization problem, we can achieve exponential stability 
without the knowledge of an inertia matrix. For both cases, 
the region of attraction almost covers SO(3), and the initial 
angular velocity error can be arbitrarily large, provided that 
a controller gain is sufficiently large. 

This paper is organized as follows. We present a global 
attitude dynamics model in Section [TT] A new configuration 
error function and geometric control systems on SO(3) are 
developed in Section III, followed by numerical results. 

II. Attitude Dynamics of a Rigid Body 

We consider the rotational attitude dynamics of a fully- 
actuated rigid body. We define an inertial reference frame 
and a body fixed frame whose origin is located at the mass 
center of the rigid body. The configuration of the rigid body 
is the orientation of the body fixed frame with respect to 
the inertial frame, and it is represented by a rotation matrix 
R € SO(3), where the special orthogonal group S0(3) is 
the group of 3 x 3 orthogonal matrices with determinant of 
one, i.e., SO(3) = {R € M 3x3 | R T R = I, detR= 1}. 

The equations of motion are given by 

,m + n x ,m = u, (i) 

R = RCl, (2) 



where J £ ]R 3x3 is the inertia matrix in the body fixed frame, 
and ft £ R 3 and u £ R 3 are the angular velocity of the rigid 
body and the control moment, represented with respect to 
the body fixed frame, respectively. 

The hat map A : R 3 — >• so (3) transforms a vector in ]R 3 
to a 3 x 3 skew-symmetric matrix such that xy = x x y for 
any x,y £ R 3 . The inverse of the hat map is denoted by the 
vee map V : so(3) — > R 3 . Several properties of the hat map 
are summarized as follows. 



xy = x x y = —y x x = —yx, 
1 



(3) 



tr[Ar] = -tr[x(A - A T )] = -x T (A - A T ) V , (4) 

xA + A T x = {{ti{A]I 3x3 -A}x) A 1 (5) 
RxR T = (Rx)^, (6) 

for any x,y € R 3 , A £ M 3x3 , and R £ S0(3). 

III. Geometric Tracking Control on S0(3) 

We develop a control system to follow a given smooth 
desired attitude command R d (t) G S0(3). The kinematics 
equation for the attitude command can be written as 

Rd = Rd^d, (7) 

where 57^ £ R 3 is the desired angular velocity. 

A. Attitude Error Function 

One of the important steps in constructing a control system 
on a nonlinear manifold Q is choosing a proper configuration 
error function, which is a smooth positive definite function 
>t : Q x Q -> R that measures the error between a current 
configuration and a desired configuration. Once a configu- 
ration error function is chosen, a configuration error vector, 
and a velocity error vector can be defined in the tangent 
T^Q by using the derivatives of [10]. Then, the remaining 
procedure is similar to nonlinear control system design in 
Euclidean spaces: control inputs are carefully designed as a 
function of these error vectors through a Lyapunov analysis 
on Q, where a Lyapunov candidate also is written in terms of 
fy. Therefore, a configuration error function is critical in the 
design and analysis of a control systems on a manifold, and 
the corresponding performance and effectiveness of a control 
system directly depend on the choice of a configuration error 
function. 

But, the importance of a configuration error function has 
not been extensively studied in geometric controls, and it is 
sometimes chosen without a careful consideration. Almost 
globally stabilizing controllers on SO (3) have been studied 
in [10], [13], where essentially, the following configuration 
error function is used to stabilize the attitude represented by 
the identity matrix: 



9°{I,R) = ~ij{I-R]. 



(8) 



This error function yields the following form of the config- 
uration error vector e R = (R — R T ) V £ R 3 and the velocity 
error vector = f2 £ R 3 - A simple PD-type controller, i.e. 

u° = —k R e R —kne.Q for positive constants k R ,kn, stabilizes 



the identity matrix /. This can be slightly generalized to 
achieve almost global stability. 

However, this choice of a configuration error function is 
not desirable, since the magnitude of the corresponding con- 
figuration error vector e° R is not proportional to the rotation 
angle about the Euler axis between the current attitude and 
the identity matrix: as the current attitude approaches to the 
opposite of the identity, i.e. 180° rotation to /, the magnitude 
of the attitude error vector ||e^|| approaches zero. Therefore, 
the performance of this controller becomes worse as the 
initial attitude error becomes larger. This is not particularly 
desirable, since it destroys one of the distinct advantages of 
geometric controls of a rigid body, namely effectiveness for 
large angle rotational motions. 

In this paper, we introduce a new form of the configura- 
tion error function to avoid this drawback, and to improve 
tracking performances particularly for larger initial attitude 
errors. 

Proposition 1: For a given tracking command (Rd, Qd)> 
and current attitude and angular velocity (R, f2), we define an 
attitude error function * : SO (3) x SO (3) -> R, an attitude 
error vector e R : SO(3) x SO(3) — >£ R 3 , and an angular 
velocity error vector e n ■ SO (3) x R 3 x SO(3) xR 3 -> R 3 
as follows: 



eu,(R,Rd) = 



V(R,R d ) = 2- 
1 



+ tr[B$R], 
(RjR — R T RdY , 



(9) 
(10) 



2^Jl + tr[RjR] 

en(R,n ) R d ,n) = fl-R T R d n d . (11) 

For a fixed Rd, the attitude error function ^ can be con- 
sidered as a function of R only. The attitude error vec- 
tor eu is well defined in the sublevel set = {R £ 
SO(3) \V(R,R d ) <2}. 

Then, the following statements hold: 

(i) ^ is positive definite about R = Rd- 

(ii) in L2, the left-trivialized derivative of "J is given by 

T* I l R (D R <lr(R,R d )) = e R . (12) 

(iii) the critical points of ^ are {Rd} U {Rd exp(±7rs)} for 
any s £ S 2 , and there exists only one critical point {Rd} 
in L 2 . 

(iv) is locally quadratic in L-2, since 

\\e R \\ 2 <^(R,R d )<2\\e R \\ 2 . (13) 
Proof: For any rotation matrix Q = RjR £ SO(3), its 
trace is bounded by — 1 < tr[Q] < 3, and tr[Q] = 3 if and 
only if Q = I [15]. Substituting this into (|9j, it follows that 
* > 0, and * = if and only if R — R d . This shows (i). 

The infinitesimal variation of a rotation matrix can be 
written as 

SR = — Rexpef) = Rt) 

for T] £ R 3 . Using this, the derivative of this error function 
with respect to R is given by 

d 



n R V(R, R d )-8R = 



de 



\& (Rexpef}, R d 



2^1+tv[RjR] 

This is well defined in L2, since ti[RjR\ > — 1 in L2- Using 
a property of the hat map given by this can be written 

as 



T> R *(R,R d ) •Rq = 



1 



V 1 - 



tr[RTR] 



-.(RJR — R T Rd) y 



■ >1 



which shows (ii). 

The critical points of W are the solutions R E SO (3) to 
the equation R^R - R T R d = or tv[RjR\ = -1, which 
are given by R^R — I or R^R = exp(±7rs) for any s G 
S 2 [10]. This shows the first part of (iii). From Rodrigues' 
formula, for any Q — R d R G SO(3), there exists x e M 3 
with llxll < 7r such that 



1 



_ sin kr „ 
<y = exp a; = i H ^ — ^ — a; - 



Substituting this into (|9j, we obtain 

exp x, R d ) = 4 sin 2 



COS X 



(14) 



At the critical points R = Rd exp(±7rs) with s £ S 2 , the 
value of ^ becomes 2. This shows the second part of (iv). 



Substituting (14i into (lOi, we obtain 

4 sin 2 



\ e R\ 



■ 2 \\ x \\ a ■ 2 F 2 F 
= sm 2 = 4sm 2 cos 2 — 11 . 

2 4 4 

This shows (iv). ■ 
The proposed attitude error function is more desirable than 



( 28 1 in the sense that the magnitude of the attitude error 
vector e r is proportional to the rotation about the Euler axis 
between R and Rd (see Fig. [T}. This improves the tracking 
performance, especially for large angle rotational maneuvers 
with a large initial attitude error. 




0.5 1 



(a) Attitude error function (b) Magnitude of attitude error vector 

Fig. 1. Attitude error function * and the magnitude of the attitude error 
vector || || when R^ R = exp x, for x/||a:|| = [1, 0, 0] and ||x|| S [0, it]. 
For the attitude error function $° used in other literatures (blue, dashed), 
||e°J| is maximized when \\x\\ = it/2, and it approaches as ||x|| — > 
n. This reduces the convergence rate of the corresponding control system 
significantly, when the initial attitude error approaches 180°. But, in the 
proposed attitude error function \l> (red), the magnitude of the attitude error 
vector ||eft|| is proportional to the rotation angle \\x\\ about the Euler axis 
between R and R^. This guarantees a good convergence rate uniformly in 
initial attitude errors. 



B. Attitude Error Dynamics 

We find the attitude error dynamics for the proposed 
attitude error function "J, the attitude error vector eR, and 
the angular velocity error en- 

Proposition 2: The error dynamics for ty, eR, en satisfies 

d 



dt 



(V(R,R d )) = e R ■ e n , 
■ „ !„ 



(15) 
(16) 



e n = J^i-n x JQ + u) + {lR T R d n d - R T R d tl d . (17) 
Proof: Using the attitude kinematics equations Q, 
the time derivative of the attitude error function is given by 



dt 



V(R,R d ) 



2Jl + tv[RjR] 



-At 



R^d Rd — CldR'd R 



=tr 



2Jl + tr[RTR] 



R d R(& — R T R d fl d R d R) 



where we use a property of the hat map ([6]). Substituting 
(Hi into this, and using (Hh, (|10), we obtain 



2 x /l + tv[RjR] 



tx[R T d Re n ] 



--(R d R — R T Rdf ■ en, 



2^1 + tv[RjR] 

which shows (15) . Next, the time derivative of the attitude 
error vector is given by 



tr 



en = 



-CldR'd R ~t~ R'd RCl 



en 



2(l + tr[RTR\) + 
x (~fl d RTR + rTr& + ClR T Rd - R T Rd&dY ■ 
Using (|6j, (|TTJ, this can be written in terms of en as 



tr 



en 



2(l + tr[RTR\] 

R T Rd'< 
tr[RjRen] 



R d Rv^ ~ R T Rd&dRd 1 

— en H -, = 

2^1 + tr[RTR] 

x (RjR{Cl - R T Rd&dRj R) + (Cl- R T Rdn d R T dR)R T RdY 



2{l+tr[RTR]) eR ' 2y J 1 + tl[R T R] 

x (R^Re n + enR T Rd) v - 

Using the properties of the hat map, given by (ffl, this 
can be further reduced to 



en 



eR ■ en 



-eR 



l + tr[RjR] 2^1+tr[i£i2] 
x (tr[R T R d ]I - R T R d )en 

1 =(tr[R T R d ]I - R T R d + 2e R e T R )en 
2^1 + tr[RTR] 

E(R,R d )en, (18) 



where E{R,R d ) G M 3x3 . From Rodrigues' formula, let 
Q = RjR = expz G SO(3) for x G M 3 . Us- 
ing the Matlab Symbolic Computation Tool, the eigen- 
values of E(R, R d ) 7 'E(R, R d ) are given by |, |, |(1 + 
cos 1 1 cc 1 1 ) . It follows that the matrix 2-norm of E(R,R d ) is 
\\E(R,Rd)\\ = \, which shows (16 1. 

From in, (El, Q, and using the fact that f^Qd = x 
fid = for any G M 3 , the time derivative of the angular 
velocity error en is given by 

i(i = tl + ClR T R d fl d — R T Rd&dQd — R T Rd&d 

= x jn + u) + CiR T R d n d - R T R d n d , 

which shows ( fTT) . ■ 

C. Attitude Tracking 

Here we define a control system to follow a given attitude 
command, and we show exponential stability. 

Proposition 3: For a given attitude command Rd(t), and 
positive constants k R ,kn G M, we define a control input 



u G 



as follows: 



mo)h 2 < 



X 



V(R(0),R d (0))<2, (20) 
- 2 — rfefl{2-*( J R(0), J R d (0))}, (21) 

nax ( J ) 



where A max (J) denotes the maximum eigenvalue of the 
inertia matrix J. 

Proof: We first show that the sublevel set L2 = {R G 
SO(3) I ^(R, Rd) < 2} is a positively invariant set. Consider 
the following Lyapunov function 

W = ^e n ■ Je n +k R y(R,R d ). 
According to ( [13) , this is locally positive definite. Substitut- 

(22) 



ing ( 19 1 into (fTTb, we obtain 

Jen = -k R e R - knen- 



Using (15 1, (22 1, the time-derivative of VV is given by 



VV = en • {-k R e R - k n e n ) + k R e R ■ en 
= -k R \\en\\ 2 <0. 



This implies that W{t) < W(0) for all t > 0, and from ( [29) , 
we have 

1 



W(0) < -A ma> , 



(J)||en(0)|| 2 +fc fl *(J?(0), J R d (0)) < 2k R . 

Therefore, we obtain 

k R *(R(t),R d (t)) < W(i) < W(0) < 2k R 

for all t > 0. This follows that * (R(t) , R d (t)) < 2 always. 
So, the sublevel set L 2 — {R G SO(3) | V(R, R d ) < 2} is a 
positively invariant set under the given assumptions. Then, 



according to Proposition [T[ the attitude error vector e R is 
well defined, and there exists only one critical point of ^ in 
L 2 . 

To show exponential stability, we consider the following 
Lyapunov function: 

V = ■ J e n + k R ty(R,R d ) + c 2 en ■ e R 
for a positive constant c 2 . From ( [T3"] l, we obtain 

z T W n z < V < z T W l2 z, (23) 
2 , and the matrices Wu, W\ 2 G 



where z = [||e fl ||; ||e n ||] G 

113)2x2 



are given by 

k- 1 



■ R 
\c 2 



2 c 2 

2 Amin 



Wv 



2k R 

|c 2 



5C 2 

1 X 

2 "max 



u = -k R e R - k Q e n + Q x .m - J(ClR T R d n d - R T R d tl d ). 

(19) 

This control system stabilizes the zero equilibrium of the 
tracking error e R , en exponentially, and an estimation of the 
region of attraction is given by 



From $22\ , (JT3J, ( |18) , the time derivative of the Lyapunov 
function V along the solution of the controlled system is 
given by 

V = en ■ Jen + k^ + c 2 en • e R + c 2 e n ■ e R 
= en ■ {-knen - k R e R ) + k R e R ■ en 

+ c 2 (J~ 1 (-k n en - k R e R )) ■ e R + c 2 e n ■ E R (R,R d )e n - 



Using ( 16 1, this is bounded by 



V < 



(kn - 1) ||e n || 



c 2 kf 



^max(^) 



c 2 h. 



A m in( J) 

-z T W 2 z, 



l e flllll e n|| 



where the matrix W 2 G M is given by 

C2kn. c 2 kq 



w 2 



A m ax(J) 



2A„ 

kn 



2 



(24) 



(25) 



2A min (J) 

We choose the positive constant c 2 such that 

-ik R k n X 



c 2 < min |^2fc_RA min (J), 2k n , 



2 

min 



(J) 



2k R Xl in (J) + k n X ma ^(J) 



Then, the matrices Wn 1 W\ 2 ,W 2 become positive definite, 
which implies that V is quadratic, and 



V{i) < V(0) exp 



A m in(W / 2 ) 
A m ax(M /r i2 



(26) 



Therefore, the zero equilibrium of the attitude and the angu- 
lar velocity tracking error (e R ,en) is exponentially stable. 

■ 

In this paper, we claim that this control system stabilizes 
the zero equilibrium of the attitude and angular velocity 
tracking errors almost semi- globally in the sense that the 



region of attraction given by (28 1, (29 1 satisfies the following 
properties: the initial attitude region given by ( |28] > almost 
cover SO(3), since it only excludes the two-dimensional sub- 
set {R d (0) exp(±7rs), s G S 2 } from the three-dimensional 
SO (3); the initial angular velocity could be arbitrarily large 



by choosing a sufficiently larger gain k R in (29 1. 



D. Attitude Stabilization Without Inertia Matrix 

The proposed attitude tracking controller requires the exact 
value of the inertia matrix. Here, we show that in a special 
case, where the desired attitude is fixed, i.e. Orf(t) = 0, we 
can stabilize the attitude error without the knowledge of the 
inertia matrix. 

Proposition 4: Suppose that the desired attitude R d is 
fixed so that 0<j(t) = for any t > 0. For positive constant 
k R ,ka £ K, we define a control input u' E M 3 as follows: 



v! = -k R e R - k n en- 



(27) 



This control system stabilizes the zero equilibrium of the 
errors e R ,e$i exponentially, and an estimation of the region 
of attraction is given by 



|en(0)|| 2 < 



*(R(0),R d (0)) <2, (28) 
2 -k R {2-V(R(0),R d (0))}, (29) 



where A max (J) denotes the maximum eigenvalue of the 
inertia matrix J. 

Proof: Similar to the proof of Proposition [2] we first 
show that the sublevel set L 2 = {R € SO(3) | ^(R,R d ) < 
2} is a positively invariant set. Consider the following 
Lyapunov function 

W = ~e n - Je n + k R y{R,R d ). 

According to (13) , this is locally positive definite. Substitut- 
ing p7| into ( fT7| , we obtain 



Jet 



-k R e R - fcnen -Ox JO. 



(30) 



Using (15 1, (30 1, the time-derivative of W' is given by 

VV = en • (—k R e R - fcoeo -Ox JO) + k R e R ■ eo- 

According to (JTTJ, we have eo = O when O^ = 0. Thus, 
eo • (O x JO) = eo • (eo x Jeo) = 0. Then, this reduces to 

W = -^||eo|| 2 <0. 

Similar to the proof of Proposition [T] this implies that the 
sublevel set L 2 = {R € SO(3) | ^(R, R d ) < 2} is a 
positively invariant set under the given assumptions. 

To show exponential stability, we consider the following 
Lyapunov function: 



V 



-eo • Jeo + k R ^!{R 1 R d ) + c 2 e n ■ e R 



for a positive constant c 2 . This satisfies d23 



From (30 1, ( 15 i, ( 18 i, the time derivative of the Lyapunov 
function V] along the solution of the controlled system is 
given by 

V' = e • (-fcoeo - k R e R -Ox JO) + k R e R ■ e n 
+ c 2 (J _1 (-fcoeo - k R e R -Ox JO)) • e R 
+ c 2 e n ■ E R (R, R d )ea- 



Since ^(R(t),R d ) < 2, we have ||e fl || < y/2 from (13i 



We also have eo = O since O^ = 0. Then, the following 
inequality is satisfied: 

IMJ-^O x JO)) • e fl || < y2c 2 ^4^||eo|| 2 . 
Then, similar to (E?)), we obtain 



V' < 



where the matrix Wk G 



p2x2 



Wn 



C2k R 



where a 



A»ax(J) 

_ c 2 fcn 
2A min (J) 

4J) 



-z T W^z, 
is given by 

2A min (,7) 
fco — ac 2 



(31) 



v "A min (J)- 

We choose the positive constant c 2 such that 



c 2 < min < ^2k R X miD (J), 



4fc i? fc A 2 nin (J) 



a ' 4ak R X 2 miD (J) + k 2 n X max (J) 



Then, the matrices Wn,Wi 2 ,W 2 become positive definite, 
which implies the zero equilibrium of the attitude and the 
angular velocity error (e^eo) is exponentially stable. ■ 
This control system allows us to stabilize a fixed attitude 
without the knowledge of the inertia matrix, since the con- 
trol input (f27| is independent of J. But, this reduces the 



convergence rate. As discussed in ( 26 1, the convergence rate 



of the controlled system depends on the eigenvalue of the 



matrix W 2 . Comparing (31 1 with (25 i, we expect that the 
eigenvalues of W 2 are less than the eigenvalues of W 2 since 

E. Properties 

One of the unique properties of the presented controller 
is that it is directly developed on SO (3) using rotation ma- 
trices. Therefore, it avoids the complexities and singularities 
associated with local coordinates of SO(3), such as Euler 
angles. It also avoids the ambiguities that arise when using 
quaternions to represent the attitude dynamics. As the three- 
sphere S 3 double covers SO(3), any attitude feedback con- 
troller designed in terms of quaternions could yield different 
control inputs depending on the choice of quaternion vectors. 
The corresponding stability analysis would need to carefully 
consider the fact that convergence to a single attitude implies 
convergence to either of the two disconnected, antipodal 
points on S 3 [6]. This requires a continuous selection of the 
sign of quaternions or a discontinuous control system, which 
are shown to be sensitive to small measurement noise [16]. 
Without these considerations, a quaternion-based controller 
can exhibit an unwinding phenomenon, where the controller 
unnecessarily rotates the attitude through large angles [7]. In 
this paper, the use of rotation matrices in the controller design 
and stability analysis completely eliminates these difficulties. 

Another novelty of the presented controller is the choice 
of the attitude error function in It is carefully designed 
to guarantee a good tracking performance for large attitude 
error. In contrast to other attitude control systems on SO (3) 



constructed by (28 i [10], [13], the magnitude of the attitude 
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(d) Control input u (Nm) 



Fig. 2. Attitude tracking (proposed controller: red, solid, control system 
constructed by (28): blue, dashed, command:black,dotted) 
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(d) Control input u (Nm) 



Fig. 3. Attitude stabilizing without the knowledge of the inertia ma- 
trix, (proposed controller: red,solid, control system constructed by {28}: 
blue, dashed, command:black,dotted) 



error vector is proportional to the value of the attitude 
error function such that the corresponding control system 
is uniformly effective for larger attitude errors. These are 
illustrated by numerical examples in the next section. 

IV. Numerical Examples 

We choose the inertia matrix of a rigid body and initial 
conditions as follows: 

J = diag[3, 2, 1] kgm 2 
R(0) = I, fi(0) = [0, 0, 0] rad/sec 

We consider two cases: 

(i) Attitude tracking with the full knowledge of J. The 
desired attitude command is described by using 3-2-1 
Euler angles [15], i.e. R d (t) = R d {(f,(t),0(t)^(t)), 
and these angles are chosen as 

4>{t) = 0.999vr + 0.5i, 9(t) = O.lt 2 , V(t) = -0.2t + OM 2 , 

where the unit of these angles is radian, when the 
simulation time t is in seconds. The corresponding 
angular velocity command f2(i), and its time-derivative 
(l(t) are obtained from the attitude kinematics equation 
0. 

(ii) Attitude stabilization without the knowledge of J. The 
desired attitude is chosen as 

R d = exp(0.9997rs), where s = -^[1,-1, 1]. 

v3 

Since R d is fixed, we have il d (t) — & d (t) = 0- 
We use the control system ( fT9] l for the first case, and we use 
the control system (27i for the second case. For both cases, 



the controller gains are chosen as 

k R = 12, k Q = 8.4. 

Note that the desired attitude command of the first case 
represents a nontrivial rotational maneuver, and the initial 
attitude error of both cases is 0.9997T = 179.82° in terms 
of the rotation angle about the Euler axis between R(0) and 
R d (0)- 

It has been shown that general-purpose numerical integra- 
tors fail to preserve the structure of the special orthogonal 
group SO (3), and they may yields unreliable computational 
results for complex maneuvers of rigid bodies [17], [18]. 
In this paper, we use a geometric numerical integrators, 
referred to as a Lie group variational integrator, to preserve 
the underlying geometric structures of the attitude dynamics 
accurately [19]. 

Simulation results are represented in the following figures, 
where the responses of the proposed control system (red, 
solid lines) are compared with a control system based on 
(|28]i in [10], [13] (blue, dashed lines). At Fig.[T] we showed 
that the control system based on ( 28 1 yields a small control 



input when the initial attitude error is close to 180°. These 
are observed again in the subfigure (d) for both cases. As 
a result, the initial convergence rates of the attitude error 
and the angular velocity error are relatively poor in the 
subfigures (a) and (b): it takes a longer time to converge in 
blue, dashed lines. But, the proposed control system exhibits 
more desirable convergence properties for a given complex 
rotational maneuvers involving large initial attitude errors. 



V. Conclusion 

We have developed a geometric tracking control system on 
S0(3). The proposed control system is constructed directly 
on SO (3) to avoid singularities and ambiguities that are 
inherent to other attitude representations, and its tracking 
performance is guaranteed uniformly in large initial attitude 
errors. We also show that in a special case where the desired 
attitude command is fixed, the proposed control system does 
not require the full knowledge of an inertia matrix. 
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